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摘 要 : 为 同时 实现 果园 智能 植保 机 自主 导航 及 自动 对 靶 喷 雾 ， 研 制 了 一 种 果园 自主 导航 兼 自 劲 对 靶 喷 雾 
机 器 人 。 首 先 采 用 单个 3D LIDAR (Light Detection and Ranging) 采集 果树 信息 确定 兴趣 区 (Region of Inter- 
est, ROI), ， 对 ROI 内 点 云 进行 2D 化 处 理 得 到 果树 质心 坐标 ， 通 过 随机 一 致 性 (Random Sample Consensus, 


RANSAC) 算法 得 到 果树 行 线 ， 并 确定 果树 行 中 间 线 〈 导 航线 )， 进 而 控制 机 器 人 沿 导 航线 行驶 。 通 过 编码 
器 及 惯性 测量 单元 (Inertial Measurement Unit, IMU) 确定 机 体 速度 及 位 置 ，IMU 矫正 采集 到 的 果树 分 区 冠 


层 信 息 ， 最 后 通过 程序 判断 分 区 冠 层 的 有 无 控制 喷头 是 否 喷雾 。 结 果 表 明 ， 机 器 人 自主 导航 时 最 大 横向 定 
位 偏差 为 21.8 ecm， 最 大 航向 偏 角 为 4.02”"， 相 比 于 传统 连续 喷雾 机 施 药 液 量 、 空 中 漂移 量 及 地 面 流 失 量 分 别 
减少 20.06% 、38.68% 及 51.40%。 本 研究 通过 单个 3D LiDAR 、 编 码 器 及 IMU 在 保证 喷雾 效果 的 前 提 下 ， 实 


现 了 喷雾 机 器 人 自主 导航 及 自动 对 靶 喷 筋 ， 降低 了 农药 使 用 量 及 飘 失 量 。 


关键 词 : 自主 导航 ; MMS; LIDAR; 随机 一 致 性 算法 ; DAA; 惯性 测量 单元 


中 图 分 类 号 : TP242; S224.3 


文献 标志 码 : A 


文章 编号 : SA202207008 


引用 格式 : 刘 理 民 , 何 雄 奎 , 刘 伟 洪 , XU RUS, 韩 虎 , 李 扬帆 . 果园 自主 导航 兼 自动 对 靶 喷雾 机 器 人 []. E Ae 


(中 英文 ), 2022, 4(3): 63-74. 


LIU Limin, HE Xiongkui, LIU Weihong, LIU Ziyan, HAN Hu, LI Yangfan. Autonomous navigation and automatic 
target spraying robot for orchards[J]. Smart Agriculture, 2022, 4(3): 63-74. (in Chinese with English abstract) 


1 引 Ë 


目前 ， 中 国 的 果园 植保 机 半数 以 上 没有 驾驶 
室 ， 作 业 人 员 完 全 暴露 在 施 药 环境 中 “”， 而 果 
园 遥 探 植保 机 控制 范围 有 限 ， 人 机 没有 完全 分 
离 ， 存 在 一 定安 全 隐患 ”。 具 备 自主 导航 功能 的 
植保 机 人 机 完全 隔离 ， 保 障 了 作业 时 人 员 安 全 ， 
将 在 植保 设备 中 占有 很 大 的 市 场 “"。 其 中 基于 全 
球 导航 卫星 系统 (Global Navigation Satellite Sys- 
tem, GNSS) 的 自主 导航 解决 方案 已 在 野外 作业 
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环境 中 得 到 充分 应 用 “。 

现代 化 果园 采用 宽 行 密植 种 植 模式 ， 与 传统 
果园 作业 环境 相 比 具 有 行距 宽 、 株 距 罕 的 特点 ， 
株 间 枝 叶 紧 密 衔 接 呈 “ 树 墙 ” 结 构 ， 导 航 场 景 较 
为 简单 “““。 目 前 果园 自主 导航 作业 以 视觉 导航 
和 激光 导航 为 主 ””"。 视 觉 导 航 通过 摄像 头 采 集 
果园 环境 的 图 像 及 视频 信息 ， 结 合 采集 信息 中 的 
树干 颜色 、 材 质 与 形状 等 特征 对 导航 线 进行 提 
取 ， 标定 相机 内 外 参数 以 确定 机 器 人 相对 于 果树 
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的 位 置 ， 最 终 实现 自主 导航 控制 ”"。 视 觉 传 感 
器 虽然 具有 成 本 低 、 信 息 丰 富 的 优点 ， 但 成 像 质 
量 易 受 光 线 干扰 ， 不 能 直接 获取 周围 环境 的 深度 
言 息 ， 无 法 全 天 候 作 业 "。 

激光 导航 采用 LiDAR (Light Detection and 
Ranging) 对 果园 环境 进行 实时 扫 撕 ， 通 过 探测 
果园 中 不 同 果 树 位 置 ， 实 现 机 器 人 的 相对 定位 。 
激光 具有 主动 发 光 、 测 距 精 度 高 等 优点 ， 可 全 天 
候 作 业 ， 对 环境 适应 能 力 强 ""。Santos 等 '1 依 
据 同 时 定位 与 地 图 构建 (Simultaneous Localiza- 
tion and Mapping，SLAM) 技术 开发 了 不 依赖 全 
球 卫 星 导 航 系 统 (Global Navigation Satellite Sys- 
tem，GNSS) 定位 的 VineSlam 定位 与 建 图 方法 
和 专用 于 葡萄 园 的 路 径 规 划 器 “AgRobPP”， 该 
方法 的 建 图 与 路 径 规 划 效果 良好 ， 可 控制 机 器 人 
执行 多 种 任务 。 基 于 3D 激 光 雷 达 的 SLAM 技术， 
可 以 较 全 面 地 探测 周围 环境 信息 ， 增 强 机 器 人 移 
动 时 的 安全 性 ,但 也 增加 了 计算 负担 ， 对 计算 性 
能 提出 了 更 高 的 要 求 。Saike 等 "对 3D LIDAR 
数据 进行 了 2D 化 处 理 ， 实 现 了 温室 内 的 自主 导 
航 作 业 。 刘 伟 洪 等 则 使 用 3D LIDAR 实现 了 
导航 线 提取 及 自主 导航 ,但 未 对 冠 层 特征 进行 处 
理 。 以 上 研究 采用 2D LiDAR 或 将 3D LiDAR 进 
行 2D 化 处 理 以 实现 自主 导航 作业 ,但 未 获得 完 
整 果树 特征 信息 。 

上 述 导 航 传感器 在 果园 精准 变量 喷雾 中 可 用 
于 收集 果树 冠 层 特征 〈 冠 层 体积 及 叶 面 积 指 数 
等 ) 信息 ， 其 中 LiDAR 不 仅 可 用 于 自主 导航 作 
业 ， 还 能 获取 周围 果树 特征 以 用 于 精准 变量 喷雾 


2D LiDAR， 水 平安 装 的 3D LIDAR 可 以 探测 周 
围 环境 较为 完整 的 信息 …“'。 

通过 以 上 研究 可 知 ，LiDAR 可 实现 全 天 候 信 
息 采 集 ， 而 3D LIDAR 可 获取 周围 环境 前 后 及 上 
下 (一 定 角 度 ) 的 三 维 信息 。 以 上 研究 未 能 使 用 
单个 3D LIDAR 实现 既 能 自主 导航 又 能 自动 对 台 
喷雾 作业 。 基 于 上 述 情况 ， 本 研究 利用 水 平安 闭 
的 3D LIDAR 获取 果树 点 云 信息 并 截取 合适 感 兴 
趣 区 (Region of Interest，ROI) ， 并 对 了 ROI 内 的 
点 云 进 行 裁剪 、 滤 波 、 欧 式 聚 类 及 2D 化 等 处 理 ， 
得 到 果树 质心 位 置 。 通 过 随机 一 致 性 (Random 
Sample Consensus, RANSAC) 算法 ， 得 到 机 体 
左右 果树 行 线 公 式 ， 依 据 果 树 行 线 得 到 导航 线 公 
式 ， 最 终 控 制 机 体 沿 导航 线 行驶。 同时 通过 7 个 
不 同 ROI 中 同 棵 果树 的 分 区 冠 层 有 无 信息 逻辑 计 
算得 到 上 、 中 、 下 分 区 冠 层 的 有 无 信息 ， 依 据 冠 
层 有 无 进行 自动 对 靶 喷 雾 。 最 后 对 机 器 人 进行 自 
主导 航 性 能 和 喷雾 性 能 测试 ， 并 进行 数据 绘制 ， 
为 果园 智能 植保 机 械 研 究 提供 参考 。 


2 材料 与 方法 


2.1 硬件 设计 


图 1 为 整个 机 器 人 系统 硬件 部 分 ， 由 传感器 
模块 、 控 制 模块 、 驱 动 模块 、 对 靶 执 行 模块 及 电 
源 模块 等 组 成 ， 图 中 绿色 线 表示 电源 供给 ， 蓝 色 
线 表示 信息 传递 。 传 感 器 模块 主要 由 编码 器 、 惯 
性 测量 单元 (Inertial Measurement Unit, IMU) 、 
LiDAR 及 RTK GNSS 等 组 成 。LiDAR 不 仅 用 于 


作业 “”， 在 果园 精准 变量 喷雾 方面 应 用 最 为 ) 

泛 ”。 李 龙 龙 等 ”及 密 汉 杰 等 ”采用 紧 直 安 
装 的 2D LiDAR 获 取 果 树 特征 信息 ， 分 别 实现 了 
仿 形 变量 喷雾 及 自动 对 靶 喷 筋 〈《 有 和 冠 层 时 喷雾 ， 
无 冠 层 时 不 喷雾 是 精准 变量 喷雾 技术 的 一 
Ah? )， 达 到 了 减少 农药 漂 失 、 节 省 药 液 的 目 
的 。 探 测 果树 信息 时 ，LiDAR 竖 直 安装 可 尽量 多 
地 获取 果树 外 貌 轮 廊 特 征 信息 ,但 机 体 前 进 方向 
为 探测 盲区 无 法 实现 自主 导航 作业 "”"。 相 比 于 


自主 导航 作业 ， 同 时 也 用 于 探测 果树 冠 层 特征 。 
所 以 LiDAR 的 选择 是 关键 ， 本 研究 采用 的 是 16 
线 机 械 式 3D 激光 雷达 (深圳 市 速腾 聚 创 科技 有 
限 公 司 )， 探 测 范围 水 平方 向 360*、 垂 直方 向 
30°, PRUNE SIA 150 m， 探 测 精度 +2 cm, FEEL 
角 分 辨 率 为 2"， 在 10 Hz 频率 下 工作 时 水 平角 分 
辩 率 为 0.18" ， 供 电 范 围 为 DC 9~32 V, 采用 
100 M 以 太 网 与 工控 机 通信 。 每 秒 接受 32 万 个 点 
云 数据 。 
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图 1 机 器 人 硬件 设计 图 


Fig. 1 Hardware design ofthe robot 


E6B2-CWZ6C 型 编码 器 (分 辨 率 为 1000 pm 
(pulse per ring， 脉 冲 每 转 ) ) 提供 速度 信息 ， 通 
过 连接 轴 与 机 器 人 主动 轮 (直径 24 cm) 共 轴 连 
接 。 机 器 人 在 行驶 过 程 中 ， 会 发 生 偏 移 、 倾 斜 与 
车 轮 打 滑 等 现象 ， 而 ICM-20948 型 IMU 可 提供 
更 为 准确 的 速度 和 机 体 状 态 。IMU 自 带 卡尔 曼 滤 
波 程序 ， 可 提供 稳定 精确 的 数据 ; 静态 精度 
0.05 %/s， 义 、Y 方 向 动态 精度 0.1 %/s， 无 磁场 干 
扰 时 Z 轴 精度 1%s， 加 速度 精度 0.02 g， 陀 螺 仪 
精度 为 0.06 V/s， 数据 最 大 输出 频率 为 200 Hz 
(本 研究 采用 100 Hz)。 为 验证 机 器 人 导航 性 能 ， 
移动 轨迹 测量 系统 需 具 有 足够 高 的 精度 ， 采 用 兼 
容 了 世界 主流 六 大 卫星 定位 系统 的 “P3-DU” 
RTK GNSS 定位 系统 ， 其 水 平定 位 精度 为 +1 cm, 
数据 输出 频率 最 大 为 20 Hz (采用 20 Hz)， 供 电 
范围 为 DC 9~36V。 

面 对 每 秒 32 万 个 点 云 ， 中 央 处 理 器 (Central 
Processing Unit，CPU) 需 具 有 极 强 算 力 ， 同 时 
考虑 恶劣 的 果园 作业 环境 ， 处 理 器 应 具有 足够 的 
防护 等 级 '， 选 择 处 理 器 为 这 10510U，16 G 
RAM, 1T HAEA, W2 Ubuntul8.04 Linux 操 
作 系 统 ， 拥 有 RS232、 以 太 网 、USB 及 RS485 等 多 
种 通信 接口 ， 供 电 范围 为 DC 9~36 V 的 国产 工 
探 机 。 微 控制 器 控制 机 体 运 动 及 自动 对 靶 喷 雾 的 
执行 装置 ， 同 时 采集 编码 器 信息 ， 采 用 M3S 型 
STM32 单 片 机 ， 世 片 为 stm32f103zet6， 采 用 cor- 


tex-M3 协议 ，144 个 引 脚 flash 内 存 为 512 k, 
主 频 72 MHz， 同 时 拥有 CAN、USB 及 RS232 等 
多 种 通信 接口 。 

本 研究 选用 2 台 800 W 的 直流 无 刷 伺 服 电 机 
(SDGAO8CIIAB, 48 V 供电 ) 为 机 器 人 提供 动 
J, WA 1:30 的 变速 箱 (60TDF-147050-L2H, 
中 国 嘉兴 )， 并 配 有 SDGA-21A 型 伺服 电机 驱动 
器 控制 电机 转速 ， 驱 动 器 通过 CAN 总 线 接受 来 自 
单片机 的 角速度 控制 信号 (通信 速率 为 500k bps, 
Intel 编 码 格 式 )。 机 器 人 在 空 载 时 最 大 行驶 速度 
为 1.5 m/s， 最 大 把 坡 角 度 为 30*。 可 通过 左右 主 
动 轮 不 同 转速 实现 差 速 转向 并 能 360° 原 地 转向 。 
对 靶 执 行 装置 安装 在 轴 流 风机 出 风口 两 侧 ， 根 据 
冠 层 信息 有 无 控制 不 同 喷头 的 开 闭 ; 安装 了 可 控 
制 管道 通 断 的 2W150-15 型 电磁 阀 (24 V 供电 ， 
中 国 宁 波 ADEC 公 司 )， 使 用 N 沟 道场 效应 MOS 
(Metal-Oxide-Semiconductor， 场 效应 管 ) 管控 制 
电磁 阀 供 电 通 断 ， 进 而 控制 电磁 阀 开启 关闭 ， 
MOS 管 由 单片机 IO (Input/Output) 口 输出 的 高 
低 电 平 进行 控制 。 

除 上 述 功能 模块 外 ， 还 需 电源 模块 提供 电源 
供给 。 采 用 48 YV 的 磷酸 铁 锂电 池 (SK-48V100 
Ah), ， 电 池 容 量 为 100 Ah 满 电 电 压 约 为 55.2 Vo 
同时 ， 安 装 有 可 为 不 同 功 能 模块 (5, 12, 24% 
48V 供 电 ) 提供 稳定 电压 的 稳 压 器 组 。 

喷雾 系统 由 26 A 型 柱 塞 泵 提供 液 路 压力 ， 
WE DE SS ASEAN, TEMES 
PEN at Be PREP fa rE WRAL 170 FAM 
机 输出 轴 上 三 角 皮 带 带 动 ， 机 体 后 方 的 风机 通过 
轴 与 机 体 前 方 的 皮带 轮 连接 ， 该 皮带 轮 同样 由 汽 
油 机 带动 。 药 箱 内 液体 经 过 和 泵 后 进入 三 路 液体 分 
配器 ， 每 个 分 配器 分 别 引 出 3、4、3 液 路 至 喷 
头 ， 喷 头 与 液 路 间 安 装 有 电磁 阀 。 


2.2 工作 流程 


机 器 人 通过 图 2 流程 实现 自主 导航 及 自动 对 
靶 喷 雾 ， 具 体 实现 过 程 将 在 随后 章节 详细 介绍 。 
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图 2 自主 导航 及 自动 对 靶 喷 雾 实 现 流 程 图 
Fig. 2 Implementation flow chart of autonomous navigation 


and automatic target Spraying 
2.3 导航 功能 的 具体 实现 过 程 


2.3.1 坐标 确定 
本 研究 的 自主 导航 兼 自动 对 靶 喷 雾 机 器 人 如 
图 3 所 示 。 


注 :1. 橡 胶 履 带 ;2. 主动 轮 ;3. RTK GNSS 移动 站 ;4. AHL; 5. Li- 


DAR;6. 2A; 7. 药 箱 ;8. 喷 头 ;9. 轴 流 风机 
图 3 自主 导航 兼 自动 对 靶 喷 雾 机 器 人 实物 图 


Fig. 3 Physical picture of autonomous navigation and au- 


tomic target spraying robot 


由 机 器 人 基本 信息 和 运动 学 理论 构建 机 体 下 
一 瞬间 世界 坐标 系 下 的 笛 卡 尔 坐标 及 偏 航 角 
(x,y, 0) 如 公式 (1) 所 示 : 


Xwi Xwo COS(Ayo) XT 1 
Jw|=|lyw sn(O)xT x| n (1) 
Ay, Axo 1 


其 中 ，x,、yw 为 当前 笛 卡 尔 坐 标 ; 9, 为 偏 
MA, C); rAblat A EI #1, 12cm; œ 


为 整个 机 器 人 运动 的 角速度 ，rad/s; At 为 一 帧 雷 
达 数 据 的 时 间 ，0.1 so 
2.3.2 ” ROI 的 提取 

如 图 4 所 示 LiDAR 水 平安 装 在 机 器 人 行驶 前 
方 ， 安 装 高 度 1.3 m， 最 大 测 距 为 150 m， 理 论 上 
可 以 感知 面积 约 为 7hm2? 的 圆 形 果园 ，10 Hz 频率 
下 每 帧 有 32,000 个 点 云 数据 。 机 器 人 仅 需 要 机 体 
前 后 一 定 范围 内 的 点 云 信 息 ， 过 多 的 信息 会 造成 
数据 元 余 ， 影 响 整 个 系统 的 实时 性 ， 需 对 宛 余 信 
息 进行 裁剪 以 提取 合适 的 ROI。 


图 4 LIDAR 测量 范围 


Fig. 4 Measurement range of LIDAR 


在 果园 实现 机 右 人 定位 和 自主 导航 仅 需 机 体 
两 侧 果 树 行 前 后 的 数 棵 果树 即 可 ,而 本 研究 
的 ROI 不 仅 给 机 器 人 导航 提供 定位 信息 ， 还 需 获 
取 果 树 完 整 的 外 貌 轮廓 特征 信息 。 图 4 是 作业 过 
程 中 3D LIDAR 对 一 侧 果树 的 探测 情况 ， 距 Li- 
DAR 近 的 果树 仅 有 局 部 冠 层 被 探测 到 ， 较 远 的 
果树 能 被 完全 探测 到 ;红线 表示 激光 束 ， 黑 线 表 
示 LiDAR 到 树 行 的 垂直 距离 (果树 行距 的 一 半 
D2, 行距 4m)， 蓝 线 表 示 LiDAR 到 目标 果树 的 
线性 距离 (dg) ， 蓝 线 、 红 线 及 果树 (平均 高 度 为 
H, 4.05m) 构成 直角 三 角形 。 该 果树 是 距离 Li- 
DAR 最 近 的 可 探测 全 部 冠 层 特征 信息 的 果树 (机 
体 前 方 的 第 n 棵 果树 ,株距 为 R,1.5 m)。 其 中 雷 
达 安 装 高 度 为 h, 由 图 4 中 的 几何 关系 得 到 公 
式 (2)， 带 入 数据 知 z 取 7。 


4 (2) 
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由 此 设 ROI 的 X 范 围 为 [-3.0m, 10.5 m], 
YH [-25m, 25m], ZW [-1.9m, 48m], 
前 进 方向 为 世界 坐标 X 轴 正方 向 。 使 用 点 云 库 
(Point Cloud Library, PCL) 的 直通 滤波 器 对 x、 
y、z 三 个 维度 进行 裁剪 ， 得 到 ROI 的 最 终 范 于。 
直通 滤波 器 简单 高 效 ， 可 在 指定 维度 下 遍历 点 云 
中 的 每 个 点 ， 并 判断 该 点 在 指定 维度 上 的 取 值 是 
否 在 值 域内 ， 删 除 不 在 范围 内 的 点 。 

2.3.3 ”ROI 中 的 果树 定位 及 导航 

使 用 PCL 体 素 化 降 采 样 函 数 将 体 素 尺寸 变 为 
(0.05 m，0.05 m，0.05 m) ， 进 一 步 降低 点 云 数 
量 提高 运算 速率 ， 并 将 处 理 后 的 点 云 结果 进行 存 
储 ， 将 机 器 人 在 该 ROI 区 域 的 世界 坐标 信息 存储 
到 同一 内 存 中 方便 快速 计算 。 

使 用 PCL 的 统计 滤波 函数 将 噪声 去 除 ， 采 用 
PCL 的 欧式 聚 类 算法 对 点 云 进行 聚 类 得 到 点 云 数 
据 已 ， 设 最 小 距离 浆 值 为 w3， 聚 类 点 的 最 小 和 
最 大 数目 分 别 为 10 和 5500 个 。 聚 类 后 将 点 云 投 
影 至 YXO7Y 面 ， 计 算 投影 后 点 云 质 心 (Xi, Yi, 0) 
为 果树 位 置 。 依 据 IMU、 编 码 器 、LiDAR 及 果 
树 位 置 ， 当 机 器 人 行驶 到 不 同行 果树 中 间 位 置 时 
更 新 一 次 ROI。 树 行 拟 合 采 用 RANSAC 算法 , 
导航 线 获取 及 导航 跟踪 算法 与 文献 [15] 相同 ， 
最 终 传递 给 下 位 机 具体 的 角速度 大 小 。 


2.4 软件 系统 的 编写 与 设计 


为 提高 开发 效率 ,减少 重复 开发 ， 软 件 系统 
主要 基于 时 下 流行 的 机 器 人 操作 系统 (Robot 
Operating System, ROS) 平台 行 开发 。 使 用 C/ 
C++ 作为 主要 开发 语言 ， 基 于 ROS Melodic 及 
Ubuntu18.04 进行 信息 采集 处 理 包 、 树 行 识别 功 
能 包 、 导 航线 提取 包 、 运 动 控制 功能 包 、 分 区 冠 
层 有 无 信息 逻辑 计算 包 及 自动 对 靶 喷 雾 决策 包 的 
开发 ， 如 图 5 所 示 。 整 个 系统 分 为 应 用 层 、 控 制 
层 、 驱 动 层 及 自动 对 靶 喷 雾 层 ， 其 中 最 重要 的 是 
控制 层 和 自动 对 靶 喷 雾 层 。 


= 一 ~ 
E kie AREE RAEI EAE | 
untu ) I 
上 $ 

动 | ———------------------------ i 
p 控制 导 ere oe we 
对 ios) 信息 采集 | 桂 行 识别 “| | 导航 线 提取 | 1 
Oe) | 
te Seek oe es ee ee | 
a — 机 器 人 位 置 及 运动 方向 控制 程序 | 
ae Ubuntu) 1 
EY 1 
系 ea 1 
2 BANAS 果树 分 区 冠 层 有 无 信息 远 辑 | 
统 CUbuntu) 计算 存储 及 自动 对 裔 喷 雳 程序 ! 
a es ee a ta a a saa a a sl a iw Sw ea oss ee ee 1 


图 5 自动 对 靶 喷 雾 系统 软件 构成 
Fig. 5 Implementation flow chart of automic target 


spraying system 
25 自动 对 靶 喷 雾 的 实现 


2.5.1 果树 分 区 冠 层 有 无 信息 的 确定 

确定 果树 分 区 冠 层 的 有 无 是 实现 自动 喷雾 的 
关键 。 机 器 人 正常 作业 过 程 中 ，ROI 内 包含 9 棵 
果树 ，LiDAR 距 喷头 1.5m，LiDAR 从 收集 数据 
到 最 后 的 自动 对 靶 喷 雾 需 一 定 的 反应 时 间 ， 所 以 
舍弃 位 于 LiDAR 后 方 4 棵 果树 的 点 云 。 使 用 IMU 
获取 的 翻 深 及 偏 移 角 信息 矫正 ROI 内 剩余 果树 冠 
层 点 云 ， 重 新 得 到 果树 中 心 坐标 位 置 〈 树 干 ) ， 
将 果树 冠 层 到 雷达 距离 值 D. 与 树干 到 雷达 距离 值 
D, 进 行 比较 ， 若 D. 大 于 D, 则 该 处 为 空隙 (无 冠 
层 )， 反之 有 冠 层 。 同 时 将 ROI (长 10.5 m) 两 
侧 果树 分 为 长 度 为 30 cm 大 小 的 35 个 小 分 区 ， 并 
根据 ROI 更 新 频率 将 果树 冠 层 上 下 分 为 7 层 ， 如 
图 6 所 示 。 


图 6 果树 冠 层 分 区 示意 图 


Fig. 6 Diagram of fruit tree canopy zoning 


LIDAR 动态 扫描 机 体 两 侧 果 树 ， 将 机 体 在 果 
树 间 行驶 的 具体 距离 融合 到 LiDAR 点 云 信息 中 ， 
对 ROI 进 行 较为 精准 的 分 区 。 机 体 行驶 到 不 同行 
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果树 中 间 位 置 时 更 新 ROI 并 矫正 机 体位 置 ， 以 消 
除 IMU 及 编码 需 轨 迹 预 测 的 累计 误差 。 


注 :1. 未 更 新 ROI 时 LiDAR 可 检测 到 的 冠 层 范围 ;2. 第 一 次 更 新 
ROI 后 LiDAR 可 检测 到 的 冠 层 范围 ;3. 第 二 次 更 新 ROI 后 LiDAR 
可 检测 到 的 冠 层 范围 


图 7 果树 分 区 


Fig. 7 Zoning of fruit tree 


由 于 水 平安 装 的 3D LIDAR 垂直 视 场 的 局 限 
性 ， 整 个 ROI 内 仅 完 整地 得 到 LiDAR 前 方 第 7 棵 
果树 的 点 云 。 图 7 中 的 点 划 线 框 是 第 一 个 ROI 内 
可 探测 到 的 果树 冠 层 ， 第 一 次 更 新 ROI 后 可 探测 
到 实 线 框 内 的 果树 冠 层 ， 第 二 次 更 新 ROI 后 为 虚 
线 框 内 的 果树 冠 层 ， 依 次 类 推 直 至 第 七 次 更 新 
ROI 机 体 运 动 到 该 果树 位 置 。LiDAR 距离 果树 较 
远 时 ， 所 测 的 果树 信息 极 易 受到 机 体 状态 (倾斜 
等 ) 的 影响 ， 需 使 用 距 LiDAR 较 近 黑色 框 内 冠 
层 有 无 对 点 划 线 框 内 冠 层 有 无 进行 矫正 ， 然 后 使 
FARE LIDAR 更 近 的 虚线 框 内 有 无 信息 对 黑色 框 
内 信息 进行 矫正 。 具 体 使 用 公式 (3) 进行 逻辑 
计算 实现 上 述 过 程 。 

ni(k) or n (k) or ees 

n, (k) and n,(k) (3<k<7) 

其 中 ,nn 为 第 个 ROI 区 ; k 是 冠 屋 从 上 到 下 
第 个 分 区 ; or 为 逻辑 “或 ”运算 ; and 为 逻辑 
“与 ”运算 。 当 Kk<2 时 ， 取 n，(k) 的 值 。 

可 将 果树 分 为 7 个 倾斜 的 分 区 ， 上 两 个 区 域 
为 上 层 ， 下 两 个 区 域 为 下 层 ， 其 余 为 中 层 。 
2.5.2 ”喷头 及 导 流 板 的 调整 

如 图 3 所 示 ， 共 有 10 个 喷嘴 ， 每 侧 S 个 ， 调 
整 喷嘴 的 位 置 和 方向 使 其 喷 向 冠 层 ， 果 树 上 层 对 


(3) 


一 个 喷嘴 ， 中 下 层 各 两 个 喷嘴 。 将 玻璃 绳 固定 
在 导 流 板 上 ， 启 动 风机 ， 观 察 玻璃 绳 漂 浮 方 向 是 
否 与 果树 冠 层 对 齐 ， 若 不 齐 ， 继 续 调 整 导 流 板 直 
至 对 齐 。 

2.6 数据 绘制 
采用 OriginPro 2020 绘 制 试验 结果 图 。 
3 试验 设计 
为 验证 自主 导航 性 能 ， 于 2021 年 10 月 11 

日 ， 在 北京 市 平谷 区 峪 口 镇 西 营 村 现代 化 佛 见 嘉 
梨 种 植 园 进行 了 自主 导航 及 喷雾 性 能 验证 试验 ， 
试验 过 程 中 天 气 晴 ， 温 度 为 17.2~18.5 "C ， 风 速 
为 0.8~1.3 m/s。 图 8 是 自主 导航 和 喷雾 试验 示意 
图 ， 气 象 站 在 距 基 站 10 m 远 的 位 置 用 于 收集 气 


象 条 件 ，RTK GNSS 基站 在 距 试 验 区 域 15.5m 
远 的 开阔 地 带 。 


99999999 
9999999? 


00900909099 


azm (RTK GNSS % ens 0 试验 果树 — 行驶 方向 
图 8 自主 导航 和 自动 对 靶 喷 雾 试验 示意 图 


Fig. 8 Test schematic of autonomous navigation and an- 


tomic target spraying 
3.1 导航 试验 


试验 前 用 RTK GNSS 移 动 站 探测 试验 区 两 侧 
行 首 及 行 末 果树 坐标 ， 得 到 果树 行 公式 ， 进 而 得 
到 导航 线 公 式 。 试 验 时 将 机 器 人 放置 在 果园 地 头 
果树 行 中 间 启 动 电源 和 汽油 机 ， 随 后 启动 自动 对 
靶 喷 雾 程 序 ， 沿 着 图 8 中 黑色 箭头 行驶 进 试验 
区 ， 试 验 区 距 地 头 10.53 m, 长 100 m， 宽 4 m， 
行驶 过 试验 区 2 m 后 减速 至 停止 ,试验 重复 3 次 。 
定义 运动 轨迹 在 导航 线 右 侧 为 横向 正 偏差 ， 航 回 
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角 偏 向 导航 线 右 侧 为 正 。 

试验 时 机 器 人 上 的 RTK GNSS 移动 站 接受 机 
体 运 动 中 的 位 置信 号 并 得 到 运动 轨迹 ， 获 取 不 同 
时 刻下 轨迹 点 到 导航 线 的 垂直 距离 为 机 器 人 自主 
导航 时 的 横向 偏差 。 以 导航 线 为 基准 线 ， 某 个 时 
刻 的 偏 航 角 可 表示 为 轨迹 线 与 导航 线 的 夹 角 。 


3.2 喷雾 对 比试 验 


为 验证 机 器 人 的 喷雾 性 能 ， 如 图 8 所 示 选 择 
试验 区 中 的 3 棵 果树 作为 喷雾 性 能 试验 植株 。 试 
验 果 树 的 布 样 点 如 图 9 所 示 ， 将 试验 果树 分 
ALL PL FZE, 分 别 距 地 面 3.2m、2.4 m 及 
1.6 mm 高 (树干 平均 高 度 为 1.15 mm)， 每 层 按照 东 
西南 北 中 布置 5 片 直径 为 7 cm 的 滤纸 (使 用 双关 
夹 固定 ) 用 于 收集 雾 滴 ， 并 在 试验 果树 底部 及 距 
离 底 部 0.75 m 处 的 左右 两 侧 各 布置 3 片 (每 片 相 
距 0.5m) 直径 为 7 cm 的 滤纸 用 于 收集 施 药 过 程 
中 的 地 面 流 失 。 同 时 在 距 试 验 树干 1.5 m 人 处 布置 
5 mm 高 的 竖 直 立 杆 ， 在 距 地 面 高 为 0.2、0.8、1.4 
eee 5.0m (间隔 0.6 m) 处 用 双 头 夹 竖 直 固定 
400 目的 长 方形 金属 网 (2.5 cmX7.5 cm) 共 9 个 
用 于 收集 农药 漂移 ， 每 三 个 为 一 组 ， 将 金属 网 分 
为 上 、 中 、 下 三 层 。 

使 用 3.0 g/L 的 柠檬 黄 溶液 作为 试验 示 踪 剂 ， 
试验 前 取 药 箱 内 的 母液 放置 暗箱 内 保存 。 自 动 对 
靶 喷 雾 与 传统 连续 〈 简 称 传统 ) 喷雾 为 同一 机 
器 ， 区 别 在 于 自动 对 靶 喷 雾 启 动 自动 对 靶 喷 
雾 程 序 ， 而 传统 喷雾 不 启动 。 每 次 喷雾 试验 机 具 
行进 100m， 收 集 样 品 到 6 号 自封 袋 中 。 

以 去 离子 水 为 洗 脱 液 ， 对 自封 袋 样品 进行 洗 
脱 处 理 ， 在 自封 袋 内 放置 50 mL 的 去 离子 水 后 将 
其 密封 ， 用 NMY-100A 型 水 平 授 床 振荡 器 对 样品 
进行 振荡 以 充分 溶解 沉积 雾 滴 ， 使 用 100 pL 移 
液 枪 采集 袋 内 溶液 滴 和 人 比 色 焉 中 ， 放 置 到 722 s 
型 可 见 光 分 光 光 度 计 内 ， 在 波长 426 nm 的 可 见 
光 下 测定 吸光 值 ， 根 据 文献 [25] 的 方法 得 到 样 
品 的 沉积 量 扩 ， 同 时 依据 滤纸 面积 得 到 单位 面积 
筋 滴 沉 积 量 。 两 种 喷雾 模式 使 用 同一 药 箱 内 的 洲 


机 器 人 行驶 方向 


(a) 信 视图 


空中 漂移 采样 点 


地 面 流失 采样 点 
e 
e 


机 器 人 行驶 方向 
一 


(b) 侧 视图 


图 9 喷雾 测试 样品 布置 图 
Fig. 9 Spray test sample layout 

液 但 喷雾 量 不 同 ， 为 对 比 两 种 喷雾 模式 的 优 劣 ， 
使 用 文献 (25, 26] 的 方法 对 冠 层 内 沉积 量 进行 
归 一 化 处 理 ， 具 体 计算 方法 如 公式 (4) 所 示 。 
V, x 10° 
Vx (4) 

其 中 ，4, 为 归 一 化 单位 面积 沉积 量 ，pL/em?; 
让 为 样品 沉积 量 ，kL; VIME, L/h; SH 
样品 面积 ， cm’, 


4 试验 结果 及 分 析 


d,= 


4.1 自主 导航 性 能 试验 结果 及 分 析 


图 10 为 自主 导航 时 机 器 人 横向 偏差 的 小 提 
琴 箱 线 图 ， 表 示 横 向 偏差 的 分 布 状态 及 概率 密 
度 。 由 图 10 (a) 知 3 次 试验 的 平均 值 和 中 位 数 
丝 为 负 值 ， 说 明 机 体 大 部 分 时 间 行 驶 在 导航 线 的 
左 侧 ， 且 试验 2 平均 值 和 中 位 数 相 差 较 大 而 试验 
1、3 无 明显 差别 ; 由 图 10 (b) 知 绝对 值 多 小 于 
15 cm， 甚 至 是 10 em, 平均 数 和 中 位 数 小 于 10 cm, 
说 明 该 具有 和 较 高 的 导航 准确 性 ( 相 比 于 4 m 的 行 
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PR), 试验 2、3 平 均值 及 中 位 数 无 明显 差别 ， 试 
验 1 差 别 明 显 ， 说 明 试 验 1 运 动 轨迹 在 导航 线 左 
侧 时 间 占 比 最 多 ， 试 验 3 其 次 ， 试 验 2 较 少 。3 次 
试验 最 大 横向 偏差 绝对 值 为 21.8 cmo 


国 国 25"% 一 75% 
1.5IQR 内 的 范围 
20 上 一 均值 线 
。 中 位 数 
g 10 F 
NN 
E 
E of 
ps 
一 10 上 
一 20 E 
试验 1 试验 2 试验 3 
(a) 横 向 偏差 
30 | 国电 25%~75% 
1.5IQR 内 的 范围 
一 均值 线 
。 中 位 数 
20 上 
g 
m 
z 
= of 
0 L 
试验 1 试验 2 试验 3 


(b) 横 向 偏差 绝对 值 
图 10 机 器 人 横向 偏差 测试 结果 


Fig. 1 Test results of lateral deviation of the robot 


UNL 11A, JE 3 KIAI Lae A E id A 
绝对 值 箱 线 图 ， 最 大 值 为 4.02*。 随 着 试验 进行 ， 
航向 偏 角 的 平均 值 逐 渐 减 小 ， 可 能 是 随 着 试验 进 
行 ， 试 验 区 内 果园 道路 被 机 器 人 压 平 ， 使 得 原本 
崎 虹 的 果园 地 面 变 得 较为 平整 ， 机 体 不 易 发 生 倾 
斜 ， 航 向 偏 角 也 变 得 更 小 、 更 稳定 。 由 以 上 试验 
结果 可 知 ， 目 主导 航 性 能 满足 基本 需求 。 


4.2 喷雾 对 比试 验 结果 及 分 析 


使 用 两 种 喷雾 模式 在 试验 区 进行 喷雾 作业 时 
测量 药 液 用 量 ， 传 统 喷 雾 和 自动 对 靶 喷 雾 分 别 消 
耗 药 液 量 为 20.24 和 16.18L， 换 算 成 每 公顷 施 药 


45 
__|25%~75% 
4.0 上 一 — I 1.5IQR 内 的 范围 
T 一 中 位 线 
3.5 。 均值 
， 异常 值 
3.0 上 
Ssh 2 
= F 
220 
1.5 b 
1.0 iL 
0.5 H AE 
1 È 1 
试验 1 试验 2 试验 3 


图 11 机 器 人 航向 偏 角 测试 结果 


Fig. 11 Steering declination test results of the robot 


液 量 则 分 别 为 506 和 404.5 L/hmz， 相 比 于 传统 喷 
雾 模 式 ， 本 研究 设计 的 自动 对 靶 喷 雾 技 术 可 节省 
20.06% 的 农药 量 。 

图 12 为 果树 冠 层 内 部 实际 雾 滴 沉积 量 与 各 
点 占 比 及 进行 归 一 化 处 理 后 数据 可 视 化 图 。 由 图 
12 (a) 和 12 (b) 可 知 ， 传 统 喷雾 与 自动 对 丢 喷 
雾 各 点 沉积 量 占 比 相差 无 几 ， 自 动 对 靶 喷 雾 总 沉 
积 量 仅 比 传统 喷雾 少 10.19%， 但 在 归 一 化 沉积 
后 自动 对 靶 喷 雾 却 比 传统 喷雾 增加 了 12.38%, 
这 说 明了 自动 对 靶 喷 雾 节省 药 液 量 造成 实际 沉积 
量 有 所 减少 ， 但 喷雾 效果 优 于 传统 喷雾 ， 这 是 因 
为 传统 喷雾 在 空隙 处 也 喷雾 ， 浪 费 了 较 多 农药 。 
理论 上 传统 喷雾 与 自动 对 靶 喷 雾 在 冠 层 内 部 沉积 
量 相 同 ， 而 实际 喷雾 作业 中 自动 对 靶 喷 雾 沉 积 量 
较 少 ， 可 能 是 自动 对 靶 喷 雾 控 制程 序 延 时 函数 及 
冠 层 有 无 信息 存在 误 判 导致 。 

图 13 是 自动 对 靶 喷 雾 和 传统 喷雾 在 上 、 中 、 
下 层 空 中 实际 漂移 量 及 占 比 情况 ， 两 者 都 是 中 、 
下 层 的 漂移 量 占 比 最 大 分 别 为 47%、42% 和 
41%、49%， 而 上 层 漂移 量 仅 占 比 11% 和 10%， 
其 中 传统 喷雾 漂移 量 随 着 收集 杆 高 度 的 增加 而 减 
少 ， 这 是 因为 中 上 层 喷 雾 距 离 较 远 ， 大 雾 滴 难 以 
达到 ， 而 到 达 的 雾 滴 穿 透 能 力 较 弱 无 法 穿 透 冠 层 
漂移 到 金属 筛 网 上 而 是 沉积 到 了 和 冠 层 内 部 和 地 
面 ， 所 以 上 部 漂移 量 占 比 最 少 ; 自动 对 靶 喷 雾 中 
部 雾 滴 占 比较 多 ， 可 能 是 因为 调整 了 喷头 及 导 流 
板 角 度 。 相 比 于 传统 喷雾 ， 自 动 对 靶 喷 雾 的 平均 
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空中 漂移 可 减少 38.36%， 大 大 降低 了 农药 漂移 的 风险 。 
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(a) 实 际 雾 滴 沉 积 量 (b) 实 际 雾 滴 沉 积 量 占 比 
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TS 喷雾 模式 喷雾 模式 
(c) 归 一 化 雾 滴 沉积 量 (d) 归 一 化 雾 滴 沉积 量 占 比 


注 :ATS :自动 对 靶 喷 雾 (Automatic Target Spraying) ; TS :传统 连续 型 喷雾 (Traditional Spraying) 
图 12 自动 对 靶 喷 雾 和 传统 喷雾 的 喷雾 沉积 测试 对 比 结果 


Fig. 12 Comparison results of deposition tests between automic target spraying and tranditional spraying 
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图 13 自动 对 靶 喷 雾 和 传统 喷雾 的 空中 漂移 量 
Fig. 13 Airl drift of automic target spraying and tranditional spraying 
图 14 是 自动 对 靶 喷 雾 和 传统 喷雾 的 地 面 流 ”部 ,采样 点 A、C 是 试验 果树 左右 两 侧 ， 可 知 自 
失 量 及 采集 点 占 比 情 况 ， 其 中 采样 点 B 为 果树 底 ” 动 对 靶 喷 雾 的 地 面 流 失 量 远 小 于 传统 喷雾 ， 且 相 
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比 于 传统 喷雾 ， 自 动 对 靶 喷 雾 地 面 流失 量 减 少 
51.36%， 可 大 大 降低 农药 对 土壤 的 污染 。 相 比 
于 两 者 在 漂移 量 占 比 方面 相似 的 情况 ， 在 地 面 
流失 量 占 比方 面 完 全 相反 ， 自 动 对 靶 喷 雾 的 采 
样 点 BB 地面 流 失 量 占 比 最 大 为 43%， 采样 点 A、 
C 占 比 几乎 相同 ; 而 传统 喷雾 恰好 相反 ， 采 样 点 
B 占 比 最 小 为 23%， 采 样 点 A、C 占 比 较 大 且 几 
乎 相同 。 这 是 因为 采样 点 A、C 点 是 试验 果树 与 
临近 果树 的 冠 层 间 空 除 ， 自 动 对 靶 喷 雾 在 空隙 
处 不 喷雾 而 传统 喷雾 无 视 标 靶 差异 在 空 险 处 喷 
雾 ， 造 成 了 果树 间 空 除 处 无 效 喷雾 进而 造成 地 
面 流失 严重 ， 自 动 对 靶 喷 雾 空 阶 处 不 喷雾 冠 层 
区 域 正 常 喷雾 ， 这 可 能 是 自动 对 靶 喷 雾 果 树 底 
部 地 面 流失 量 占 比 较 大 的 原因 。 该 机 器 人 相 比 
于 传统 喷雾 机 ， 农 药 空 中 漂移 量 减少 了 38.68%， 
地 面 流 失 量 减少 了 51.40%， 降 低 了 施 药 过 程 中 
对 环境 的 污染 。 


5 结 论 


本 研究 采用 单个 3D LiDAR、 编 码 器 及 IMU 
实现 了 果园 机 器 人 的 自主 导航 和 自动 对 靶 喷 雾 
作业 。 同 时 设计 了 自主 导航 性 能 试验 及 喷雾 性 
能 试验 ， 试 验 结果 表明 该 机 器 人 完全 满足 果园 
自主 导航 和 自动 对 靶 喷 雾 的 要 求 ， 主 要 结论 
如 下 。 

(1) 该 机 器 人 在 自主 导航 过 程 中 ， 机 器 人 
最 大 横向 偏差 为 21.8 cm， 最 大 航 角 为 4.02"， 完 
全 满足 基本 的 果园 自主 导航 作业 需求 。 

(2) 该 机 器 人 相 比 于 传统 喷雾 机 ， 施 药 液 
量 可 减少 20.06%， 虽 然 冠 层 内 沉积 量 减少 了 
12.38%， 却 提高 了 喷雾 性 能 且 雾 滴 空 中 漂移 量 
减少 了 38.68%， 地 面 流失 量 减少 了 51.40%， 可 
降低 施 药 机 具 对 环境 的 污染 。 

(3) 该 机 器 人 与 传统 喷雾 机 在 农业 空中 漂 
移 量 占 比方 面 无 明显 差别 ， 而 在 地 面 流 失 占 比 
方面 ， 在 试验 果树 底部 地 面 流失 占 比 最 大 为 
A3% ， 试 验 果树 与 左右 临近 果树 的 中 间 流 失 量 占 
比较 小 分 别 为 29% 及 28%， 而 传统 喷雾 机 地 面 
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图 14 自动 对 靶 喷 雾 和 传统 喷雾 的 地 面 流失 量 
Fig. 14 Ground loss of automic target Spraying and trandi- 


tional Spraying 


流失 量 占 比 情况 与 之 相反 。 
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Abstract: To realize the autonomous navigation and automatic target spraying of intelligent plant protect machinery in orchard, 
in this study, an autonomous navigation and automatic target spraying robot for orchards was developed. Firstly, a single 3D 
light detection and ranging (LIDAR) was used to collect fruit trees and other information around the robot. The region of inter- 
est (ROI) was determined using information on the fruit trees in the orchard (plant spacing, plant height, and row spacing), as 
well as the fundamental LIDAR parameters. Additionally, it must be ensured that LIDAR was used to detect the canopy informa- 
tion of a whole fruit tree in the ROI. Secondly, the point clouds within the ROI was two-dimension processing to obtain the fruit 
tree center of mass coordinates. The coordinate was the location of the fruit trees. Based on the location of the fruit trees, the 
row lines of fruit tree were obtained by random sample consensus (RANSAC) algorithm. The center line (navigation line) of the 
fruit tree row within ROI was obtained through the fruit tree row lines. The robot was controlled to drive along the center line 
by the angular velocity signal transmitted from the computer. Next, the ATRS's body speed and position were determined by en- 
coders and the inertial measurement unit (IMU). And the collected fruit tree zoned canopy information was corrected by IMU. 
The presence or absence of fruit tree zoned canopy was judged by the logical algorithm designed. Finally, the nozzles were con- 
trolled to spray or not according to the presence or absence of corresponding zoned canopy. The conclusions were obtained. The 
maximum lateral deviation of the robot during autonomous navigation was 21.8 cm, and the maximum course deviation angle 
was 4.02°. Compared with traditional spraying, the automatic target spraying designed in this study reduced pesticide volume, 
air drift and ground loss by 20.06%, 38.68% and 51.40%, respectively. There was no significant difference between the automat- 
ic target spraying and the traditional spraying in terms of the percentage of air drift. In terms of the percentage of ground loss, 
automatic target spraying had 43% at the bottom of the test fruit trees and 29% and 28% at the middle of the test fruit trees and 
the left and right neighboring fruit trees. But in traditional spraying, the percentage of ground loss was, in that sequence, 25%, 
38%, and 37%. The robot developted can realize autonomous navigation while ensuring the spraying effect, reducing the pesti- 
cides volume and loss. 


Key words: automatic navigation; automatic target spraying; LiDAR; random sample consensus algorithm; robot; IMU 
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